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NEW HIGH ORDER SUFFICIENT CONDITIONS FOR CONFIGURATION 

TRACKING 

M. BARBERO-LINAN, M. SIGALOTTI 


Abstract. In this paper, we propose new conditions guaranteeing that the trajectories of 
a mechanical control system can track any curve on the configuration manifold. We focus 
on systems that can be represented as forced affine connection control systems and we 
generalize the sufficient conditions for tracking known in the literature. The new results 
are proved by a combination of averaging procedures by highly oscillating controls with 
the notion of kinematic reduction. 


1. Introduction 

New geometric techniques are used to generalize tracking conditions known in the litera¬ 
ture [1, 2, 3]. The tracking problem plays a key role in the performance of robots and me¬ 
chanical systems such as submarines and hovercrafts in order to avoid obstacles, stay nearby 
a preplanned trajectory, etc. 

Mechanical control systems are control-affine systems on the tangent bundle of the configu¬ 
ration manifold Q. In order to simplify the motion planning tasks for these control systems, 
a useful tool has been introduced in the geometric control literature, namely, the notion 
of kinematic reduction. Such a procedure consists in identifying a control-linear system on 
Q whose trajectory mimic those of the mechanical system. This approach has been useful 
to describe controllability, planning properties [1] and optimality [4] of mechanical systems. 
However, as described in [1], kinematic reduction is not always possible, some conditions 
related to the symmetric closure of the control vector fields of both systems under study must 
be satisfied. 

In our previous work [2] we extended the first-order sufficient conditions for tracking pro¬ 
posed in [1] by using different families of vector fields, possibly of infinite cardinality. Related 
constructions to generate admissible directions for tracking have been proposed in [5, 6] (see 
also [7, 8]). 

Our first goal in this current paper is to establish a relationship between families of vector 
fields defined pointwise and sets of sections of the tangent bundle defined in a recurrent 
way, similarly to the classical Malgrange theorem [9]. This new pointwise characterization of 
families of vector fields used in [2] allows to use kinematic reduction in order to obtain more 
general sufficient tracking conditions. As a result, it can be proved that an underwater vehicle 
with a natural choice of control vector fields is always trackable, even in the most symmetric 
case (see the example in Section 4.4 for more details). 

The paper is organized as follows. Section 2 contains all the necessary background in forced 
affine connection control systems [1]. Section 3 defines the notion of trackability under study. 
After recalling in Section 4.1 the high-order tracking conditions known in the literature and 
obtained by averaging theory [2], kinematic reduction is used to obtain more general tracking 
conditions in Section 4.3. The full characterization of the trackability of the system describing 
the motion of an underwater vehicle is achieved in Section 4.4, concluding the study started 
in [3] and continued in [2]. 
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2. Notation and preliminaries 


Denote by N the set of positive natural numbers and write No for N U {0}. Fix n G N. 
From now on, Q is a n-dimensional smooth manifold and X(Q) denotes the set of smooth 
vector fields on Q. All vector fields are considered smooth as functions on Q, unless otherwise 
stated. Let tq : TQ —> Q be the canonical tangent projection. A vector field, along tq is a 
mapping X: TQ —» TQ such that tq o X = tq. We denote by I a compact interval of the 
type [0,t], t > 0 . 


2.1. Affine connection control systems. The trajectories 7 : I —> Q of a Lagrangian 
mechanical systems on a manifold Q are minimizers of the action functional 


A L fil) = J L(t, 7 (t))dt 

associated with a Lagrangian function L: lx TQ —> R. 

The solutions to this variational problem must satisfy the well-known Euler-Lagrange equa¬ 
tions, 


d_ / dL_ \ 
dt 





( 1 ) 


where (q l ,v l ) are local coordinates for TQ. ffere we consider controlled Euler Lagrange 
equations obtained by modifying the right-hand side on the above equation, as follows: 


d (dL\_dL = ^ u yi 

df \dv x J dq l a 

x ' n — 1 


* = 1,... ,n, 


with u a : I —>• R, Y* ■ Q —»• R. 

When the manifold Q is endowed with the Riemannian structure given by a Riemannian 
metric g and the Lagrangian function L g {v q ) = ^g(v q ,v q ) is considered, the solutions to (1) 
turn out to be the geodesics of the Levi-Civita affine connection V 9 associated with the 
Riemannian metric. (See [1] for more details and for many examples of mechanical control 
systems that fit in this description.) 

When control forces are added to the geodesic equations we obtain an affine connection 
control system 

k 

v 7( t) i(t) = J2 Ua ^ Ya ^^^ 

a— 1 

where Y\, ..., Yk are vector fields on Q. 

The notion of affine connection control system can be extended without the need of the 
Levi-Civita connection. 


Definition 2.1. An affine connection is a mapping 

V: X(Q) x £(Q) —> X(Q) 

(X, Y) ^ V(X,Y) = V x Y, 

satisfying the following properties: 

(1) V is R -linear on X and on Y; 

(2) V fx Y = fV x Y for every f G e°°(Q); 

(3) V.y fY = /V X Y + ( Xf)Y, for every f G G 00 (Q). (Here Xf denotes the derivative 
of f in the direction X.) 


The mapping V X Y is called the covariant derivative ofY with respect to X. Given local 
coordinates ( q l ) on Q , the Christoffel symbols for the affine connection in these coordinates 
are given by 


V 


d 

dq r 


y r 4 

3 r 


_d_ 

dq v 


j,r = 1,..., 


n. 
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From the properties of the affine connection, we have 


V*Y 


E 


dY 1 

X 3 - -hr* X 3 Y ? 

dq 3 3r 


d_ 

dq l 1 


where X = £?, i X l d/dq i and Y = £? =1 Y l djdq\ 


Definition 2.2. A forced affine connection control system (FACCS) is a control me¬ 
chanical system given by S = {Q, V, Y, &, U ) where 

• Q is a smooth n-dimensional manifold called the configuration manifold, 

• Y is a smooth time-dependent vector field along the projection tq : TQ —> Q, affine 
with respect to the velocities, 

• W is a set of k control vector fields on Q, and 

• U is a measurable subset o/R fe . 

A trajectory 7 : / CR->Q is admissible for S iff: I —> TQ is absolutely continuous and 
there exists a measurable and bounded control u: I U such that the dynamical equations of 
the control system E 

k 

V-y(t) f(t) = Y(t,f(t)) +'^2u a (t)Y a ('y(t)), (2) 

a— 1 

are fulfilled (for almost every t £ I). 


The vector field Y includes all the non-controlled external forces; e.g., the potential and 
the non-potential forces. The assumption that Y is affine with respect to the velocities means 
that, in every local system of coordinates on TQ, Y can be written as 

n 

Y(t,v q ) =Y 0 (t,q) + ^2,v l Y\t,q). 

i =1 

Equation ( 2 ) can be rewritten as a first-order control-affine system on TQ, 

k 

T(t) = Z(Y{t)) + Y v (t, T(*)) + £ u a (t)Y a v (T(t)), (3) 

a —1 

where T: I -A TQ is such that tq o T = 7 , Z is the geodesic spray associated with the affine 
connection on Q and, for every X e X.(Q), X v denotes the vertical lift of X (see [10] for more 
details). 

Apart from the usual Lie bracket that provides X(Q) with a Lie algebra structure, one can 
associate with V the following product in X(Q). 


Definition 2.3. The symmetric product is the map 

(•:•): X(Q) x X(Q) —► X{Q) 

(X,Y) ^ XxY + XyX. 


It can be proved that 
(see [ 1 ]). 


[Y^,[Z,Y b v ]] = (Y a : Y b ) v 


( 4 ) 


3. Tracking problem 

We consider here the problem arising when one tries to follow a particular trajectory on the 
configuration manifold, called reference or target trajectory, which is in general not a solution 
of the FACCS considered. A trajectory is successfully tracked if there exist solutions to the 
FACCS that approximate it arbitrarily well. 

Consider any distance d: Q x Q —iRonQ whose corresponding metric topology coincides 
with the topology on Q. 
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Definition 3.1. A curve 7 : I —> Q of class C 1 is trackable for the FACCS £ if, for every 
strictly positive tolerance e, there exist a control u e £ L°°(I,U) and a solution £ e : / —» Q to 
£ corresponding to u e such that £ e ( 0 ) = 7 ( 0 ) and 

d(7 (t),C(t)) < e 

for every t £ I. The trajectory is said to be strongly trackable for £ if, in addition to 
the above requirements, for every e > 0 the approximating trajectory may be found also 
satisfying £ e ( 0 ) = 7 ( 0 ). 

A control system £ satisfies the configuration tracking property (CTP) (respectively, 
the strong configuration tracking property (SCTP)) if every curve on Q of class C 1 is 
trackable (respectively, strongly trackable) for £. 

Remark 3.2. Since any C 1 curve can be uniformly approximated, with arbitrary precision, 
by a smooth curve having the same tangent vector at its initial point, then £ satisfies the CTP 
(respectively, the SCTP) if and only if every curve on Q of class C°° is trackable (respectively, 
strongly trackable) for £. o 

3.1. Tracking results for control-linear systems. A control-linear system (also called 
driftless kinematic system ) on Q is a triple (Q, SF, U) where ST is a finite subset {Xi,..., X m } 
of £(Q) and U is a measurable subset of R m , identified with the control system 

m 

7 (t) ='^2u a (t)X a (’y(t)), 7 (t) £ Q, 

a= 1 

where ui (-),..., u m (j are measurable and bounded functions with (ui(t ),..., u m {f)) £ U for 
every t. 

Proposition 3.3 (See [11, 12]). Let X\,... ,X m be smooth vector fields on Q and take n £ N. 
Let {Xi ,..., Xm} be the set of all Lie brackets of the vector fields Xi ,..., X m of length less 
than or equal to k. Assume that 7 : / —> Q is a C°° curve such that 

rh 

7 (t) = 

a= 1 

with w : I —y M m smooth. Then, for every e > 0 there exists a solution of the control- 
linear system ( Q , {A'i,... ,X m },R m ) with smooth control u e : I —>• and initial condition 

7 e( 0 ) = 7 ( 0 ) such that d( r y(t),'y e (f)) < e for every t £ I. 

From the above proposition we deduce the following result. (Similar arguments can be 
found in [13].) 

Corollary 3.4. If the Lie algebra Lie(Xi,..., X m ) generated by X\,... ,X m has constant 
rank on Q, then for every smooth curve 7 : / —> Q and for every e > 0 there exists a solution 
7 e of the control-linear system ( Q , {X\,... ,X m },R m ) with smooth control u e : I —» R m and 
initial condition 7 e ( 0 ) = 7 ( 0 ) such that d("f(t),'y e (t)) < e for every t £ I. 

Proof. The proof works by covering the compact set 7 (d) by finitely many open sets Oi,..., f Ik 
of Q such that for every j = 1,..., K there exists on f lj a basis of the distribution Lie(Xi,..., X m ) 
made of Lie brackets of X\,... ,X m . Let k be the maximum of the length of the brackets 
used to construct such bases and let {X \,..., Xm} be the set of all Lie brackets of the vector 
fields Xi ,..., X m of length less than or equal to k. Then 

rh 

7 (t) = '^2w a (t)X a ('y(t)), 

a—1 


with w : I smooth and we conclude by Proposition 3.3. 
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3.2. Previous strong configuration tracking results. Conditions guaranteeing the SCTP 
have been obtained in [2], generalizing previous results presented in [1] (in particular Theorem 
12.26) and in [3]. We recall them here below in a version adapted to what follows. The main 
difference of these statements from the ones of Theorem 4.4 and Corollary 4.7 in [2] is that 
here we focus on the strong configuration trackability of a given trajectory, instead of looking 
at the SCTP. The proof is however exactly the same, since the proof proposed in [2] is based 
on an argument where the target trajectory is fixed. 

Proposition 3.5. Let E = (Q, V, Y, 31, R fe ) beaFACCS. Construct the following set of vector 
fields on Q: 

JCq = span eoo(Q) ^, 

= J^i -co{(Z: Z) | Z £ Lpft.i)}, 

for l £ N, where, for A C £(Q), L(A) = An (—A), co(A) denotes the convex hull of A, and A 
is the closure of A in X(Q) with respect to the topology of the uniform convergence on compact 
sets. 

Fix a smooth reference trajectory 7 re f : I —> Q of class C°°. Assume that there exist 
l,N £ N, Ai,..., Ajv £ C°°(I, [0, +oo)), and Z±,..., Z jy £ such that 

N 

V 7 ,effi)Tref(£) - F(t,7 re f(i)) = '^2\ a (t)Z a ('y Iei (t)), Vf £ I . 

a— 1 

Then 7 re f is strongly trackable. 

Proposition 3.6. Let E = (Q, V, Y, be a FACCS. Define the following sets of vector 

fields for l £ N, 

J)=J1_ 1 U{(Z a : Z b ) \Z a ,Z b £m-i}. (6) 

Assume that there exists l £ N such that for each i £ {0,..., Z — 1}, for each Z £ 

(Z: Z) £ span e oo 

Let = {Z \,..., Zjy}. Fix a smooth reference trajectory 7 re f : I —>• Q of class C°°. If 
there exist Ai,..., Ajv £ C°°(I , K.) such that 

N 

V W *)7refW - y(t,7ref(t)) = ^ X a (t)Z a (j Iei (t)), Vt £ I, 

a— 1 

then 7ref is strongly trackable. 

4. A GENERALIZATION OF TRACKING CONDITIONS 

Before introducing the new results about tracking, we need some technical lemmas de¬ 
scribed in Section 4.1 and to define kinematic reduction in Section 4.2. All that is necessary 
to prove the new theorem about trackability in Section 4.3. 

4.1. Pointwise and sectionwise characterisation of J^. The results in this section, in 
the spirit of the classical Malgrange theorem (see [9]), aim at characterizing the sets of 
sections of TQ, introduced above, in terms of iterated computations of subsets of TQ. Let 
us then associate with a family <3/ = {Yj,..., Yfc} C £(<3), in addition to the family the 
family of subsets of TQ defined pointwise, for every q £ Q, as 

JC 0 , q = span K ^(g), (7) 

i^= if-i, g -co{(Y: Z){q) | Z£X(Q), Y(g') £L(^T-i, 9 ') Vg'£ Q}, 
where for any A C £(Q) we write A(q) = {Y(g) | Y £ A} C T q Q. 


(8) 
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Recall that each is a convex cone in X(Q) for the C° oc topology (see [2, Proposition 
4.1]). It is also clear that the recursive definition of describes a closed convex cone of 
T q Q. 

We need a preliminary result to establish the equivalence between the two definitions. 

Lemma 4.1. Let Jtf be a G\ QC -closed set of X{Q) and assume that JtL is closed with respect 
to finite linear combinations with coefficients in G °°(Q, [0, oo)). Then 

3# = {V £ X(Q) | V(q) £ VgGQ}. (9) 


Proof. The inclusion 


JP c {V £ X(Q) I V(q) £ VqeQ} 


is trivial and we are left to prove the opposite one. 

If V £ X(Q) and V ( q ) S Jl?(q) for all q £ Q, then for every q £ Q there exists W q £ 
such that W q (q) = V(q). For all e > 0 there exists a closed neighbourhood Gt q ’ e such that 

\\W q — V||oo,n9.‘ < e, 


where || • || 00i n<i.« is the supremum norm restricted to Ll q ' e , with respect to any fixed Riemannian 
structure on Q. For every e > 0, {fl q,e } qe Q is an open covering of Q. Let (Qn)ne n be an 
increasing sequence of compact subsets whose interiors cover Q. For every neN there exists 
a finite covering f2 9l,1 ' n , ..., Q qr n A / n 0 f Q n and a partition of unity or,..., a Tn subordinated 
to {fsuch that 

r n 

a iW qi - v 

i=l 



In particular, the sequence (Xa=i a iW qi ) n( z N is contained in Jtf and converges uniformly to 
V on compact sets. As Jtf is closed, it follows that V £ ■ 


Proposition 4.2. For every integer l > 0, let and q be the convex cones defined in (5) 
and (8) respectively. Then 

Jffl = {F G X(Q) I V(q) £ Jffiq)} (10) 

and 

Jfii(q) = Xi, q , for every q £ Q. (11) 


Proof. We first prove (10) by induction on l. According to Lemma 4.1, it is enough to prove 
that if V £ JtTi and a £ G°°(Q 1 [0,oo)), then aV £ Jtf. The step l = 0 is trivial. Let l > 1 
and assume that the property is true for l — 1. Since Jtf-± — co {{Z: Z) \ Z £ is 

C° oc -dense in and { a 2 | a £ C°°((5,M)} is C^-dense in G°°(Q, [0, oo)), it is enough to 
prove that a 2 V £ Jfij for every V £ Jtf-i — co {{Z: Z)\Z £ L(Jtf-i)} and a £ C°°(Q, R). 
Write V = W — J2j=i ^j{Zj '■ Zj) with W £ 1 , Ai, ..., Xj > 0 with J2j =i A j = 1 and 

Zi,... ,Zj £ L(Jti-i). By induction hypothesis a 2 W £ Jffi-i. Moreover, L(J^_i) is also a 
C^c-dosed set of X(Q), closed with respect to finite linear combinations with coefficients in 
e°°(Q, [0, oo)). Hence, applying Lemma 4.1 to Jtf = L(j£/_i) we deduce that aZi,..., aZj 
belong to L(^_i). It can be easily proved using (4) that 

(■ a Zj '■ aZj) = a 2 (Zj : Zfi) + bjZj 

for some smooth function bj. By induction hypothesis, bjZj is in Hence, —a 2 (Zj: Zfi) 

lies in — co{(Z: Z)\Z £ concluding the proof of the identity Jtf = {V £ 

X(Q) | V(q) £ Jfffiq)}. 
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As a consequence, if Z(q) £ L (Jfi(q)) for all q £ Q, then Z £ L(Jdi), which implies that 

W) = {Z£ X(Q) I Z(q) £ Lpft(g)) V q £ Q}. (12) 

Let us now prove, again by induction on l, that (11) is true. The case l = 0 is trivial. 
Let us assume that (11) holds for l — 1, and let us prove it for l. According to (12) and the 
induction hypothesis, 

L(J^z_i) = {Z £ X(Q) | Z(q) £ L(j£j_i >g ) V q £ Q}. 

The definition of 3^i, q then gives 

Xi. q = jei-M - co {(Z: Z)(q) | Z £ Lp^)} 
which gives the result when compared with (5). ■ 

4.2. Kinematic reduction. It is already known in the literature that to perform certain 
motion planning tasks it is useful to reduce a mechanical control system to a control-linear 
system in such a way that there exist relationships between the trajectories of both control 
systems. Before proceeding, we introduce some necessary definitions. 

Let SC = {Xi,... ,X m } C X(Q) and consider the control-linear system (Q, 3C,R m ) (de¬ 
fined in Section 3.1). Let us introduce the notations 

Sym (0) (^), = span R ^(g), 

Sym W {&) q = Sym^(^), + span R {(W: Z)(q) \ W, Z £ &}. 

Definition 4.3. Let E = (Q, V,0, 2F,S. k ) be a FACCS. A driftless kinematic system Ekin = 
(Q, 3C,W l ) is a kinematic reduction of E if for every controlled trajectory ( 7 , Ukin) of 
Skin with rtkin smooth there exists u smooth such that ( 7,71 ) is a controlled trajectory for E. 

Let us recall the following result from [1], 

Theorem 4.4 ([ 1 , Theorem 8.18]). Let E and Eki n be as in Definition 4-3■ Assume that SC 
and *3f generate constant-rank distributions. Then Ekin is a kinematic reduction of E if and 
only if Symf- 1 '* SC q C span R ^(g) for every q £ Q. 

4.3. A new criterion for trackability. Let us now generalize the sufficient conditions for 
tracking given in Proposition 3.6. 

Theorem 4.5. Let E = (Q, V, Y, <3/, M fc ) be a FACCS. Define the families 3?i, i £ N, of 
vector fields on Q as in (6). Assume that there exists l £ N such that 

(1) Y(t,p) £ span R .J) (tq(p)) for every p £ TQ; 

(2) the distributions span R ^_i, span R ^), and Lie(^_i) have constant rank; 

(3) for all i £ {0,..., l — 1} and Z £ Sfi, (Z: Z) £ spango^g-jJ^. 

Fix a smooth reference trajectory 7 re f : I —> Q of class C°°. // 7 re f(t) £ Lie 7ref ( t ) (Sfi-i) for 
every t £ I, then 7 re f is trackable. In particular, if Lie g (3f{- 1 ) = T q Q for every q £ Q then 
the CTP holds. 

Proof. Let l be as in the statement of the theorem and consider the FACCS 

E; = (Q, V, 0, 

where mi is the cardinality of S?i. 

As recalled in Theorem 4.4, 

S i _i, ki „ = (Q,^_i,K mi - 1 ) 

is a kinematic reduction of E 1 , where w;_i is the cardinality of since Sym ( - 1 - ) (^_i) g = 

span R 3fi(q) for every q £ Q. Hence, every controlled trajectory of E;_i.ki n is also a controlled 
trajectory of Ej. 
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Since 7 re f is tangent to the distribution Lie(^_i), we deduce from Corollary 3.4 that 7 re f 
can be tracked with arbitrary precision by trajectories of Ej-ykin- 

Hence, given a positive tolerance e, there exists a controlled trajectory (71,111) of E;_yki n 
(still defined on the time-interval I) with 71 ( 0 ) = 7 re f( 0 ), Ui : I —> R 1 ™'- 1 smooth, and such 
that 

d( 7 refW, 7 iW) < e /2 

for every time t £ /. 

Now, by kinematic reduction, there exists U2 '■ I —> R mi smooth such that (71,1*2) is a 
controlled trajectory of E;. Since the distribution generated by has constant rank, we 
can represent Y(t, 71(f)) as a linear combination of Z 1 (71(f)),..., Z m , (71(f)) with coefficients 
depending smoothly on the time. We recover that 

mi 

V 7 i(*) 7 iW = ^ 2 \ a (t)Z a ('y 1 (t)), Vf £ J, 

<2=1 

with Ai,..., A m , £ C°°(I , R). 

Applying now Proposition 3 . 6 , we have that 71 is strongly trackable for E, and in particular 
there exists 1*3 : I —> R fc such that the trajectory 73 of E corresponding to 1*3 and with initial 
condition 73(0) = 71 (0) satisfies 

d( 7 iM, 73 W) < e/2 

for every f £ I. We then conclude that 7 re f is trackable for E. ■ 

In order to generalize the argument to situations in which the hypothesis that (Z : Z) £ 
spangoo(Q)^ for every Z £ 3Pi cannot be assumed, we introduce in the theorem below a new 
requirement on the linearity of the cones 

Theorem 4 . 6 . Let E = (Q, V, Y, ^) be a FACCS. Define the families i £ N, of vector 
fields on Q as in ( 5 ). Assume that there exists l £ N such that 

• Y(t,p) £ JYi(tq(p )) for every p £ TQ; 

• for all q £ Q, L(j£)_i(<?)) = and L(j£)(g)) = Atf(q); 

• the distributions Jtf-i and and Lie(J^_i) have constant rank. 

Fix a smooth reference trajectory 7 re f : I —>• Q. //7 re f(t) £ Lie 7ref ( t ) (J£)_ 1) for every t £ I, 
then 7ref is trackable. 

In particular, if Lie g (J£j_i) = T q Q for every q £ Q then the CTP holds. 

Proof. The reasoning works similarly to the one used in the proof of Theorem 4 . 5 . The first 
step is then to check that Syu/^J^j-i) C Jdi, allowing kinematic reduction arguments. By 
definition of Jdi (see ( 5 )), we know that —(Z: Z) lies in for each Z £ L(j£j_i). Moreover, 
we deduce from ( 10 ) in Proposition 4.2 and the hypothesis L(Jdj(q)) = Jdj{q) for q in Q and 
j = l — 1 , 1 , that L (Jdj) = JYj for j = l — 1 , 1 . Hence, ±(Z: Z) lies in Jij for every Z in 
JYi-i. As the symmetric product of any vector field can be written as a linear combination 
of symmetric products of vector fields with themselves, 

(Z: W) = i {{Z + W: Z + W) - {Z: Z) - {W: W)), 

we conclude that Sym^ (J£j_i) C J^j. 

Let Y = {V \,..., V m } be a set of generators of the distribution q JYi-\(q) along 7 re f, i.e., 
J^)_i(7ref(t)) = span{Hi(7 re f(t)),..., V m ( 7 re f(t))} for every t £ /. It follows from Corollary 3.4 
that the trajectories of E;_ykin = (Q, r y,W n ) can track 7 re f with arbitrary precision. Hence, 
given a positive tolerance e, there exists a controlled trajectory (71, u\) of E;_yki n (still defined 
on the time-interval I ) with 71 (0) = 7 re f(0) such that u\ is smooth and 

d( 7 ref(t), 7 iW) < e/ 2 


for every time t £ I. 
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Let = {U \,..., U r } be a set of generators of X along 71 . Since 

Sym ( 1 ) (y), C Sym ( 1 ) (^_i ) 9 C X(q) = span R {t/i((?),..., U r {q)} 

in a neighbourhood of the curve 7 re f, we deduce from Theorem 4.4 that there exists u 2 : I —>• R r 
such that ( 71 , u 2 ) is a controlled trajectory of £; = ( Q , V, 0, R r ). 

Hence 

r r 

V^i(i)7l (t) = +'52Va(t){-Ua('yi(t))), V t £ I , 

a— 1 a— 1 

with q+,...,r]+,q^,...,q- £ e°°(7, [ 0 ,+ 00 )). 

Since X has constant rank, we can represent Y ( t , 71 (f)) as a linear combination of U\ ( 71 (f)), 
..., E/ r ( 71 (f)) with coefficients depending smoothly on the time. We recover that 

r r 

Vy 1 (i)7 l{t) -Y(t,jl{t)) = + Vf £ /, 

a— 1 a— 1 

with Ai",..., A+, Aj“,..., A“ £ C'°°(/, [0, + 00 )). 

Applying now Proposition 3.5, we have that 71 is strongly trackable for S, and in particular 
there exists U 3 : I —» R fc such that the trajectory 73 of £ corresponding to 113 and with initial 
condition 73 ( 0 ) = 71 ( 0 ) satisfies 

d(7i(*),73(*)) < e/2 

for every f £ /, and we conclude that 7 re f is trackable for £. ■ 


4.4. Example. In this section we apply Theorem 4.5 to a control system studied in [2] and 
[3], completing the discussion on its trackability by tackling a case which was not covered by 
previously known criteria. 

The system models a neutrally buoyant ellipsoidal vehicle immersed in a infinite volume 
fluid that is inviscid, incompressible and whose motion is irrotational. The dynamics are 
obtained through Kirchhoff equations [14] and have a particularly simple form due to some 
symmetry assumption on the distribution of mass (see [3] for details and also [15] for general 
overview of control motion in a potential fluid). 

Consider the coordinates (co,v) for the angular and linear velocity of the ellipsoid with 
respect to a body-fixed coordinate frame. Then the impulse (n, P) of the system is given by 



where, under the symmetry assumptions mentioned above, 


M — diag(Ji, J 2 , J 3 , Mi, M 2 , M 3 ), 


diag( Ji, J 2 , J 3 ) is the usual inertia matrix, and Mi, M 2 , M 3 take into account the mass of the 
submarine and the added masses due to the action of the fluid. 

The configuration manifold Q for this problem is the Special Euclidean group or the group 
of rigid motions SE(3), which is homeomorphic to SO( 3) x R 3 . Let (A,r) £ SE(3) be the 
attitude and the position of the ellipsoid. Denote by S': M 3 —> so(3) the linear bijection 
between R 3 and the linear algebra so(3) of SO{3) such that 


S(x i,x 2 ,x 3 ) 


( 0 -x 3 x 2 

x 3 0 -Xi 

— x 2 x\ 0 


The dynamics of the controlled system are given by 


d A 

dt 


AS(co), 



(13) 
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and 


dn 

d t 


= 11 x co + P x v + 


dP 
d t 


= P X U) 



(14) 


The controls correspond to a linear acceleration along one of the three axes of the submarine 
and to two angular accelerations around the other two axes. It was proven in [3] that if 
^ M 2 then system (13)-(14) satisfies the SCTP. In [2], moreover, based on general quan¬ 
titative estimates of the convergence yielding the sufficient conditions for tracking recalled in 
Proposition 3.6, an explicit tracking algorithm was proposed. 

The Lie group structure of the configuration manifold can be exploited to compute Lie 
brackets and symmetric products of left-invariant vector fields, and in particular of the control 
vector fields. (Otherwise, one can directly apply (4).) It turns out (see [1, 16] for details) 


= ( S( "’ l) m = ( S(W2) V2 


that for r/i ( ^ 

left-invariant vector fields 


V 0 


0 


£ se(3), identified with the corresponding 


j ??i r/2 j = f{S{w 1 ),S{w 2 )] S(w!)v 2 - S(w 2 )vA 


(15) 


Let {ei,..., eg} be a basis adapted to the coordinates (A, r) so that r/ a = r/ l a ei for a = 1,2. It 
is then possible to compute the symmetric product as follows: 

(m ■ m) = -M~ 1 (ad* 1 M772 + ad* 2 M77i), (16) 

where (ad*a)£ = a(ad I? ^) for 77 , £ £ se(3), a £ se*(3). 

The structural constants with respect to the basis {ei,..., eg} are defined as 

Cij = [ei,ej] k , 7 ij = {ei-ej) k . 

By the expressions of the Lie bracket and the symmetric product given in (15) and (16), 
respectively, it follows that 


7 £. = -M hk (M il c l jh + M jl c l ih ), 

being Mr k the entries of the inverse matrix of M. 

One can easily compute that 


r 1 r 2 - 

r 3 

_4 _4 

r 5 

r 5 

„6 6 

c 23 — C 31 “ 

~ c 12 “ 

- c 26 “ c 53 

~ c 34 — 

C 61 

— c 15 — c 42 — 

r 1 r 2 . 

r 3 

_4 _4 

r 5 


r 6 r 6 

c 32 — c 13 “ 

~ C 21 

■ c 62 — c 35 

~ c 43 — 

c 16 

— C 51 — c 24 — 

and 






1 

1 

J 3 -J 2 

1 

1 

m 3 — m 2 

= 

723 = 

Jl ’ 

756 = 

765 

Ji ’ 

2 

2 

Jl-Js 

2 

9 

Adi — Ad 3 

731 = 

713 = 

h ’ 

746 = 

764 

j 2 ’ 

3 

3 

J 2 — Ji 

3 

3 

to 

1 

£ 

721 = 

712 = 

J3 ’ 

745 = 

754 

J 3 ’ 

4 

-.4 

m 3 

_ .4 

^ 4 

m 2 

726 - 

762 - 

Mi 

735 - 

753 

Mi 



m 3 



Mi 

716 = 

761 = 

m 2 ’ 

734 = 

743 

~ ~m 2 ' 

^ 6 

_ .6 

m 2 

_ 6 

~ 6 

Mi 

7l5 - 

751 - 

m 3 ' 

724 - 

742 


while all other structural constants are equal to zero. 




Notice that the control vector fields are the vertical lift to TSE(3) of 


A — ~r ei- Y 2 — — e 2 , Y 3 — —-e 6 , 
J 1 J 2 JW3 
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where left-invariant vector fields are identified with elements of the Lie algebra of SE(3). 

We focus here on the case that was left unanswered in [2] and [3], namely, the case where 

Ji = J 2 , M 1 = M 2 . (17) 

Such a case cannot be studied using the most general sufficient conditions for trackability 
given in [2] (recalled in Proposition 3.5), as illustrated by the computations here below. 
Under condition (17), one easily computes that 

(Y, : Y 2 ) = 0, <n:n> = -^Ue». <U:U> = ^. 

Moreover, 

(ej : e.j) = 0 for 1 < j < 6 . 

Let Y4 = — e 5 and Y 5 = \ e 4 . Hence, Jr = {Yj | 1 < j < 5} and condition (3) in 

JiA±i JiMi 

the statement of Theorem 4.5 is satisfied for i = 0. 

Straightforward computations also give that (Y-\ : Y4) and (Y 2 '■ Y 5 ) are proportional to I 3 , 
(I 3 : I 4 ) is proportional to Yi, ( Y 3 : Y 5 ) is proportional to Y 5 , while 

(U: y B ) = (Y 2 : Yi) = {Yi : Y 5 ) = 0 . 

Thus, = span R {ei, e 2l e 4 , es, eo) q for every q £ SE(3) and every i > 1, with condition 

(3) in the statement of Theorem 4.5 satisfied for every i > 0. 

Note that 

[U, V 2 ] = -^3 . 

J i 

Thus, Lie, [S\) = T q Q for every q £ SE(3). By Theorem 4.5 the configuration tracking 
property is guaranteed for these control vector fields. This completes the results in [2] and [3], 
allowing to conclude that system (13)-(14) satisfies the CTP for any choice of the (positive 
definite) diagonal inertial matrix 3VC. 
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